<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
<html xmlns="http://www.w3.org/1999/xhtml">
<head>
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
<meta http-equiv="X-UA-Compatible" content="IE=9"/>
<meta name="generator" content="Doxygen 1.8.14"/>
<meta name="viewport" content="width=device-width, initial-scale=1"/>
<title>BabyOS: b_modbus.c Source File</title>
<link href="tabs.css" rel="stylesheet" type="text/css"/>
<script type="text/javascript" src="jquery.js"></script>
<script type="text/javascript" src="dynsections.js"></script>
<link href="doxygen.css" rel="stylesheet" type="text/css" />
</head>
<body>
<div id="top"><!-- do not remove this div, it is closed by doxygen! -->
<div id="titlearea">
<table cellspacing="0" cellpadding="0">
 <tbody>
 <tr style="height: 56px;">
  <td id="projectlogo"><img alt="Logo" src="2.png"/></td>
  <td id="projectalign" style="padding-left: 0.5em;">
   <div id="projectname">BabyOS
   &#160;<span id="projectnumber">V1.1.0</span>
   </div>
  </td>
 </tr>
 </tbody>
</table>
</div>
<!-- end header part -->
<!-- Generated by Doxygen 1.8.14 -->
<script type="text/javascript" src="menudata.js"></script>
<script type="text/javascript" src="menu.js"></script>
<script type="text/javascript">
/* @license magnet:?xt=urn:btih:cf05388f2679ee054f2beb29a391d25f4e673ac3&amp;dn=gpl-2.0.txt GPL-v2 */
$(function() {
  initMenu('',false,false,'search.php','Search');
});
/* @license-end */</script>
<div id="main-nav"></div>
<div id="nav-path" class="navpath">
  <ul>
<li class="navelem"><a class="el" href="dir_b9223522bb56aee4ab59f7ba381d2163.html">bos</a></li><li class="navelem"><a class="el" href="dir_f2a2cc749b6bfcea90db6730434b0bd6.html">core</a></li><li class="navelem"><a class="el" href="dir_7991448cbe81caff9afaadef11b942e8.html">src</a></li>  </ul>
</div>
</div><!-- top -->
<div class="header">
  <div class="headertitle">
<div class="title">b_modbus.c</div>  </div>
</div><!--header-->
<div class="contents">
<a href="b__modbus_8c.html">Go to the documentation of this file.</a><div class="fragment"><div class="line"><a name="l00001"></a><span class="lineno">    1</span>&#160;</div><div class="line"><a name="l00032"></a><span class="lineno">   32</span>&#160;<span class="comment">/*Includes ----------------------------------------------*/</span></div><div class="line"><a name="l00033"></a><span class="lineno">   33</span>&#160;<span class="preprocessor">#include &quot;<a class="code" href="b__modbus_8h.html">b_modbus.h</a>&quot;</span></div><div class="line"><a name="l00034"></a><span class="lineno">   34</span>&#160;<span class="preprocessor">#if _MODBUS_ENABLE</span></div><div class="line"><a name="l00035"></a><span class="lineno">   35</span>&#160;<span class="preprocessor">#include &quot;<a class="code" href="b__core_8h.html">b_core.h</a>&quot;</span></div><div class="line"><a name="l00036"></a><span class="lineno">   36</span>&#160;<span class="preprocessor">#include &quot;<a class="code" href="b__device_8h.html">b_device.h</a>&quot;</span></div><div class="line"><a name="l00078"></a><span class="lineno">   78</span>&#160;<span class="keyword">static</span> <a class="code" href="structb_m_b___info__t.html">bMB_Info_t</a> bMB_InfoTable[<a class="code" href="b__config_8h.html#acd9980136a3d83c88c8d99eb9e3a7f98">_MODBUS_I_NUMBER</a>];</div><div class="line"><a name="l00079"></a><span class="lineno">   79</span>&#160;<span class="keyword">static</span> uint32_t bMB_InfoIndex = 0;   </div><div class="line"><a name="l00080"></a><span class="lineno">   80</span>&#160;</div><div class="line"><a name="l00081"></a><span class="lineno">   81</span>&#160;</div><div class="line"><a name="l00082"></a><span class="lineno">   82</span>&#160;<span class="keyword">static</span> <span class="keyword">const</span> uint8_t aucCRCHi[] = {</div><div class="line"><a name="l00083"></a><span class="lineno">   83</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00084"></a><span class="lineno">   84</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00085"></a><span class="lineno">   85</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00086"></a><span class="lineno">   86</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00087"></a><span class="lineno">   87</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00088"></a><span class="lineno">   88</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00089"></a><span class="lineno">   89</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00090"></a><span class="lineno">   90</span>&#160;    0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00091"></a><span class="lineno">   91</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00092"></a><span class="lineno">   92</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00093"></a><span class="lineno">   93</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00094"></a><span class="lineno">   94</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, </div><div class="line"><a name="l00095"></a><span class="lineno">   95</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00096"></a><span class="lineno">   96</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, </div><div class="line"><a name="l00097"></a><span class="lineno">   97</span>&#160;    0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00098"></a><span class="lineno">   98</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00099"></a><span class="lineno">   99</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, </div><div class="line"><a name="l00100"></a><span class="lineno">  100</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,</div><div class="line"><a name="l00101"></a><span class="lineno">  101</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00102"></a><span class="lineno">  102</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00103"></a><span class="lineno">  103</span>&#160;    0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,</div><div class="line"><a name="l00104"></a><span class="lineno">  104</span>&#160;    0x00, 0xC1, 0x81, 0x40</div><div class="line"><a name="l00105"></a><span class="lineno">  105</span>&#160;};</div><div class="line"><a name="l00106"></a><span class="lineno">  106</span>&#160;</div><div class="line"><a name="l00107"></a><span class="lineno">  107</span>&#160;<span class="keyword">static</span> <span class="keyword">const</span> uint8_t aucCRCLo[] = {</div><div class="line"><a name="l00108"></a><span class="lineno">  108</span>&#160;    0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7,</div><div class="line"><a name="l00109"></a><span class="lineno">  109</span>&#160;    0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E,</div><div class="line"><a name="l00110"></a><span class="lineno">  110</span>&#160;    0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09, 0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9,</div><div class="line"><a name="l00111"></a><span class="lineno">  111</span>&#160;    0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC,</div><div class="line"><a name="l00112"></a><span class="lineno">  112</span>&#160;    0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,</div><div class="line"><a name="l00113"></a><span class="lineno">  113</span>&#160;    0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32,</div><div class="line"><a name="l00114"></a><span class="lineno">  114</span>&#160;    0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D,</div><div class="line"><a name="l00115"></a><span class="lineno">  115</span>&#160;    0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A, 0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, </div><div class="line"><a name="l00116"></a><span class="lineno">  116</span>&#160;    0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF,</div><div class="line"><a name="l00117"></a><span class="lineno">  117</span>&#160;    0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,</div><div class="line"><a name="l00118"></a><span class="lineno">  118</span>&#160;    0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1,</div><div class="line"><a name="l00119"></a><span class="lineno">  119</span>&#160;    0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4,</div><div class="line"><a name="l00120"></a><span class="lineno">  120</span>&#160;    0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F, 0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, </div><div class="line"><a name="l00121"></a><span class="lineno">  121</span>&#160;    0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA,</div><div class="line"><a name="l00122"></a><span class="lineno">  122</span>&#160;    0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,</div><div class="line"><a name="l00123"></a><span class="lineno">  123</span>&#160;    0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0,</div><div class="line"><a name="l00124"></a><span class="lineno">  124</span>&#160;    0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97,</div><div class="line"><a name="l00125"></a><span class="lineno">  125</span>&#160;    0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, 0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E,</div><div class="line"><a name="l00126"></a><span class="lineno">  126</span>&#160;    0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89,</div><div class="line"><a name="l00127"></a><span class="lineno">  127</span>&#160;    0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,</div><div class="line"><a name="l00128"></a><span class="lineno">  128</span>&#160;    0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83,</div><div class="line"><a name="l00129"></a><span class="lineno">  129</span>&#160;    0x41, 0x81, 0x80, 0x40</div><div class="line"><a name="l00130"></a><span class="lineno">  130</span>&#160;};</div><div class="line"><a name="l00131"></a><span class="lineno">  131</span>&#160;</div><div class="line"><a name="l00132"></a><span class="lineno">  132</span>&#160;<span class="keyword">static</span> uint16_t _bMBCRC16( uint8_t * pucFrame, uint16_t usLen )</div><div class="line"><a name="l00133"></a><span class="lineno">  133</span>&#160;{</div><div class="line"><a name="l00134"></a><span class="lineno">  134</span>&#160;    uint8_t           ucCRCHi = 0xFF;</div><div class="line"><a name="l00135"></a><span class="lineno">  135</span>&#160;    uint8_t           ucCRCLo = 0xFF;</div><div class="line"><a name="l00136"></a><span class="lineno">  136</span>&#160;    <span class="keywordtype">int</span>             iIndex;</div><div class="line"><a name="l00137"></a><span class="lineno">  137</span>&#160;</div><div class="line"><a name="l00138"></a><span class="lineno">  138</span>&#160;    <span class="keywordflow">while</span>( usLen-- )</div><div class="line"><a name="l00139"></a><span class="lineno">  139</span>&#160;    {</div><div class="line"><a name="l00140"></a><span class="lineno">  140</span>&#160;        iIndex = ucCRCLo ^ *( pucFrame++ );</div><div class="line"><a name="l00141"></a><span class="lineno">  141</span>&#160;        ucCRCLo = ( uint8_t )( ucCRCHi ^ aucCRCHi[iIndex] );</div><div class="line"><a name="l00142"></a><span class="lineno">  142</span>&#160;        ucCRCHi = aucCRCLo[iIndex];</div><div class="line"><a name="l00143"></a><span class="lineno">  143</span>&#160;    }</div><div class="line"><a name="l00144"></a><span class="lineno">  144</span>&#160;    <span class="keywordflow">return</span> ( uint16_t )( ucCRCHi &lt;&lt; 8 | ucCRCLo );</div><div class="line"><a name="l00145"></a><span class="lineno">  145</span>&#160;}</div><div class="line"><a name="l00146"></a><span class="lineno">  146</span>&#160;</div><div class="line"><a name="l00147"></a><span class="lineno">  147</span>&#160;</div><div class="line"><a name="l00148"></a><span class="lineno">  148</span>&#160;</div><div class="line"><a name="l00166"></a><span class="lineno">  166</span>&#160;<span class="keyword">static</span> <span class="keywordtype">int</span> _bMB_l2b_b2l_16(uint16_t *pdata)</div><div class="line"><a name="l00167"></a><span class="lineno">  167</span>&#160;{</div><div class="line"><a name="l00168"></a><span class="lineno">  168</span>&#160;    uint8_t *p = (uint8_t *)pdata;</div><div class="line"><a name="l00169"></a><span class="lineno">  169</span>&#160;    <span class="keywordflow">if</span>(pdata == <a class="code" href="b__config_8h.html#a070d2ce7b6bb7e5c05602aa8c308d0c4">NULL</a>)</div><div class="line"><a name="l00170"></a><span class="lineno">  170</span>&#160;    {</div><div class="line"><a name="l00171"></a><span class="lineno">  171</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00172"></a><span class="lineno">  172</span>&#160;    }</div><div class="line"><a name="l00173"></a><span class="lineno">  173</span>&#160;    uint8_t tmp = p[1];</div><div class="line"><a name="l00174"></a><span class="lineno">  174</span>&#160;    p[1] = p[0];</div><div class="line"><a name="l00175"></a><span class="lineno">  175</span>&#160;    p[0] = tmp;</div><div class="line"><a name="l00176"></a><span class="lineno">  176</span>&#160;    <span class="keywordflow">return</span> 0;</div><div class="line"><a name="l00177"></a><span class="lineno">  177</span>&#160;} </div><div class="line"><a name="l00178"></a><span class="lineno">  178</span>&#160;</div><div class="line"><a name="l00195"></a><span class="lineno">  195</span>&#160;<span class="keywordtype">int</span> <a class="code" href="group___m_o_d_b_u_s___exported___functions.html#ga75fd562c121d4610608a1ab4053408da">bMB_Regist</a>(uint8_t dev_no)</div><div class="line"><a name="l00196"></a><span class="lineno">  196</span>&#160;{</div><div class="line"><a name="l00197"></a><span class="lineno">  197</span>&#160;    <span class="keywordflow">if</span>(bMB_InfoIndex &gt;= <a class="code" href="b__config_8h.html#acd9980136a3d83c88c8d99eb9e3a7f98">_MODBUS_I_NUMBER</a>)</div><div class="line"><a name="l00198"></a><span class="lineno">  198</span>&#160;    {</div><div class="line"><a name="l00199"></a><span class="lineno">  199</span>&#160;        <span class="keywordflow">return</span> -1;    </div><div class="line"><a name="l00200"></a><span class="lineno">  200</span>&#160;    }</div><div class="line"><a name="l00201"></a><span class="lineno">  201</span>&#160;    bMB_InfoTable[bMB_InfoIndex].<a class="code" href="structb_m_b___info__t.html#a858e2685fb0034acadcd8d48cf6f02b2">dev_no</a> = dev_no;</div><div class="line"><a name="l00202"></a><span class="lineno">  202</span>&#160;    bMB_InfoIndex += 1;</div><div class="line"><a name="l00203"></a><span class="lineno">  203</span>&#160;    <span class="keywordflow">return</span> (bMB_InfoIndex - 1);</div><div class="line"><a name="l00204"></a><span class="lineno">  204</span>&#160;}</div><div class="line"><a name="l00205"></a><span class="lineno">  205</span>&#160;</div><div class="line"><a name="l00206"></a><span class="lineno">  206</span>&#160;</div><div class="line"><a name="l00218"></a><span class="lineno">  218</span>&#160;<span class="keywordtype">int</span> <a class="code" href="group___m_o_d_b_u_s___exported___functions.html#gaec54fcf815442f741b8b3f008ea67239">bMB_WriteCmd</a>(<span class="keywordtype">int</span> no, uint8_t addr, uint8_t func, uint16_t reg, uint16_t num)</div><div class="line"><a name="l00219"></a><span class="lineno">  219</span>&#160;{</div><div class="line"><a name="l00220"></a><span class="lineno">  220</span>&#160;    <a class="code" href="structb_m_b___r_t_u_s___w__t.html">bMB_RTUS_W_t</a> wd;</div><div class="line"><a name="l00221"></a><span class="lineno">  221</span>&#160;    <span class="keywordtype">int</span> retval = -1;</div><div class="line"><a name="l00222"></a><span class="lineno">  222</span>&#160;    <span class="keywordflow">if</span>(no &lt; 0 || no &gt;= bMB_InfoIndex)</div><div class="line"><a name="l00223"></a><span class="lineno">  223</span>&#160;    {</div><div class="line"><a name="l00224"></a><span class="lineno">  224</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00225"></a><span class="lineno">  225</span>&#160;    }</div><div class="line"><a name="l00226"></a><span class="lineno">  226</span>&#160;    </div><div class="line"><a name="l00227"></a><span class="lineno">  227</span>&#160;    <span class="keywordflow">if</span>(_bMB_l2b_b2l_16(&amp;reg) &lt; 0)</div><div class="line"><a name="l00228"></a><span class="lineno">  228</span>&#160;    {</div><div class="line"><a name="l00229"></a><span class="lineno">  229</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00230"></a><span class="lineno">  230</span>&#160;    }</div><div class="line"><a name="l00231"></a><span class="lineno">  231</span>&#160;    </div><div class="line"><a name="l00232"></a><span class="lineno">  232</span>&#160;    <span class="keywordflow">if</span>(_bMB_l2b_b2l_16(&amp;num) &lt; 0)</div><div class="line"><a name="l00233"></a><span class="lineno">  233</span>&#160;    {</div><div class="line"><a name="l00234"></a><span class="lineno">  234</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00235"></a><span class="lineno">  235</span>&#160;    }    </div><div class="line"><a name="l00236"></a><span class="lineno">  236</span>&#160;    wd.<a class="code" href="structb_m_b___r_t_u_s___w__t.html#af5105c72a61e60d3b44670de20e0c3fb">addr</a> = addr;</div><div class="line"><a name="l00237"></a><span class="lineno">  237</span>&#160;    wd.<a class="code" href="structb_m_b___r_t_u_s___w__t.html#ac6b64f60b8100dc86a10a524158c21ce">func</a> = func;</div><div class="line"><a name="l00238"></a><span class="lineno">  238</span>&#160;    wd.<a class="code" href="structb_m_b___r_t_u_s___w__t.html#a11760f5020019f4aa8cb02e694f7cc44">reg</a> = reg;</div><div class="line"><a name="l00239"></a><span class="lineno">  239</span>&#160;    wd.<a class="code" href="structb_m_b___r_t_u_s___w__t.html#a8bf0d44a6ead3e7cc2898ba02498749e">num</a> = num;</div><div class="line"><a name="l00240"></a><span class="lineno">  240</span>&#160;    wd.<a class="code" href="structb_m_b___r_t_u_s___w__t.html#aa60093a9a5d5d17864cfda66c47733e3">crc</a> = _bMBCRC16((uint8_t *)&amp;wd, <span class="keyword">sizeof</span>(<a class="code" href="structb_m_b___r_t_u_s___w__t.html">bMB_RTUS_W_t</a>) - <span class="keyword">sizeof</span>(wd.crc));</div><div class="line"><a name="l00241"></a><span class="lineno">  241</span>&#160;    </div><div class="line"><a name="l00242"></a><span class="lineno">  242</span>&#160;    <span class="keywordtype">int</span> fd = -1;</div><div class="line"><a name="l00243"></a><span class="lineno">  243</span>&#160;    fd = <a class="code" href="group___c_o_r_e___exported___functions.html#ga249e47165f733672eae3653fcca87829">bOpen</a>(bMB_InfoTable[no].dev_no, <a class="code" href="group___c_o_r_e___exported___defines.html#ga0198147efa03609c64760662bd8ea00c">BCORE_FLAG_RW</a>);</div><div class="line"><a name="l00244"></a><span class="lineno">  244</span>&#160;    <span class="keywordflow">if</span>(fd &lt; 0)</div><div class="line"><a name="l00245"></a><span class="lineno">  245</span>&#160;    {</div><div class="line"><a name="l00246"></a><span class="lineno">  246</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00247"></a><span class="lineno">  247</span>&#160;    }</div><div class="line"><a name="l00248"></a><span class="lineno">  248</span>&#160;    retval = <a class="code" href="group___c_o_r_e___exported___functions.html#ga078b200cdc68be6d562cc1ad323d9381">bWrite</a>(fd, (uint8_t *)&amp;wd, <span class="keyword">sizeof</span>(<a class="code" href="structb_m_b___r_t_u_s___w__t.html">bMB_RTUS_W_t</a>));</div><div class="line"><a name="l00249"></a><span class="lineno">  249</span>&#160;    <a class="code" href="group___c_o_r_e___exported___functions.html#ga2d5143bd4493f8069401bb433939de4f">bClose</a>(retval);</div><div class="line"><a name="l00250"></a><span class="lineno">  250</span>&#160;    <span class="keywordflow">return</span> retval;</div><div class="line"><a name="l00251"></a><span class="lineno">  251</span>&#160;}</div><div class="line"><a name="l00252"></a><span class="lineno">  252</span>&#160;</div><div class="line"><a name="l00253"></a><span class="lineno">  253</span>&#160;</div><div class="line"><a name="l00254"></a><span class="lineno">  254</span>&#160;<span class="keywordtype">int</span> <a class="code" href="group___m_o_d_b_u_s___exported___functions.html#ga9e0e2e9b8286a5db0ff6ef63885b8b2e">bMB_CheckRTUS_ACK</a>(uint8_t *psrc, uint16_t len)</div><div class="line"><a name="l00255"></a><span class="lineno">  255</span>&#160;{</div><div class="line"><a name="l00256"></a><span class="lineno">  256</span>&#160;    <span class="keywordflow">if</span>(psrc == <a class="code" href="b__config_8h.html#a070d2ce7b6bb7e5c05602aa8c308d0c4">NULL</a>)</div><div class="line"><a name="l00257"></a><span class="lineno">  257</span>&#160;    {</div><div class="line"><a name="l00258"></a><span class="lineno">  258</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00259"></a><span class="lineno">  259</span>&#160;    }</div><div class="line"><a name="l00260"></a><span class="lineno">  260</span>&#160;    <a class="code" href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a> *phead = (<a class="code" href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a> *)psrc;</div><div class="line"><a name="l00261"></a><span class="lineno">  261</span>&#160;    <span class="keywordflow">if</span>((<span class="keyword">sizeof</span>(<a class="code" href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a>) - 1 + phead-&gt;<a class="code" href="structb_m_b___r_t_u_s___ack__t.html#a5723e60ffd628510c699eddbce90be23">len</a> + 2) &gt; len)</div><div class="line"><a name="l00262"></a><span class="lineno">  262</span>&#160;    {</div><div class="line"><a name="l00263"></a><span class="lineno">  263</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00264"></a><span class="lineno">  264</span>&#160;    }</div><div class="line"><a name="l00265"></a><span class="lineno">  265</span>&#160;    </div><div class="line"><a name="l00266"></a><span class="lineno">  266</span>&#160;    uint16_t crc = _bMBCRC16(psrc, <span class="keyword">sizeof</span>(<a class="code" href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a>) - 1 + phead-&gt;<a class="code" href="structb_m_b___r_t_u_s___ack__t.html#a5723e60ffd628510c699eddbce90be23">len</a>);</div><div class="line"><a name="l00267"></a><span class="lineno">  267</span>&#160;    uint16_t crc2 = ((uint16_t *)(psrc + <span class="keyword">sizeof</span>(<a class="code" href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a>) - 1 + phead-&gt;<a class="code" href="structb_m_b___r_t_u_s___ack__t.html#a5723e60ffd628510c699eddbce90be23">len</a>))[0];</div><div class="line"><a name="l00268"></a><span class="lineno">  268</span>&#160;    <span class="keywordflow">if</span>(crc != crc2)</div><div class="line"><a name="l00269"></a><span class="lineno">  269</span>&#160;    {</div><div class="line"><a name="l00270"></a><span class="lineno">  270</span>&#160;        <a class="code" href="b__config_8h.html#afc78b16ad8aebf30b9cabfc278cfb32a">b_log</a>(<span class="stringliteral">&quot;crc error\r\n&quot;</span>);</div><div class="line"><a name="l00271"></a><span class="lineno">  271</span>&#160;        <span class="keywordflow">return</span> -1;</div><div class="line"><a name="l00272"></a><span class="lineno">  272</span>&#160;    }</div><div class="line"><a name="l00273"></a><span class="lineno">  273</span>&#160;    <span class="keywordflow">return</span> 0;</div><div class="line"><a name="l00274"></a><span class="lineno">  274</span>&#160;}</div><div class="line"><a name="l00275"></a><span class="lineno">  275</span>&#160;</div><div class="line"><a name="l00276"></a><span class="lineno">  276</span>&#160;</div><div class="line"><a name="l00277"></a><span class="lineno">  277</span>&#160;</div><div class="line"><a name="l00290"></a><span class="lineno">  290</span>&#160;<span class="preprocessor">#endif</span></div><div class="line"><a name="l00291"></a><span class="lineno">  291</span>&#160;</div><div class="line"><a name="l00292"></a><span class="lineno">  292</span>&#160;<span class="comment">/************************ Copyright (c) 2019 Bean *****END OF FILE****/</span></div><div class="line"><a name="l00293"></a><span class="lineno">  293</span>&#160;</div><div class="ttc" id="structb_m_b___r_t_u_s___w__t_html_a8bf0d44a6ead3e7cc2898ba02498749e"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html#a8bf0d44a6ead3e7cc2898ba02498749e">bMB_RTUS_W_t::num</a></div><div class="ttdeci">uint16_t num</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00064">b_modbus.h:64</a></div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___w__t_html_a11760f5020019f4aa8cb02e694f7cc44"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html#a11760f5020019f4aa8cb02e694f7cc44">bMB_RTUS_W_t::reg</a></div><div class="ttdeci">uint16_t reg</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00063">b_modbus.h:63</a></div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___w__t_html"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html">bMB_RTUS_W_t</a></div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00059">b_modbus.h:59</a></div></div>
<div class="ttc" id="structb_m_b___info__t_html_a858e2685fb0034acadcd8d48cf6f02b2"><div class="ttname"><a href="structb_m_b___info__t.html#a858e2685fb0034acadcd8d48cf6f02b2">bMB_Info_t::dev_no</a></div><div class="ttdeci">uint8_t dev_no</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00083">b_modbus.h:83</a></div></div>
<div class="ttc" id="b__config_8h_html_a070d2ce7b6bb7e5c05602aa8c308d0c4"><div class="ttname"><a href="b__config_8h.html#a070d2ce7b6bb7e5c05602aa8c308d0c4">NULL</a></div><div class="ttdeci">#define NULL</div><div class="ttdef"><b>Definition:</b> <a href="b__config_8h_source.html#l00042">b_config.h:42</a></div></div>
<div class="ttc" id="group___c_o_r_e___exported___defines_html_ga0198147efa03609c64760662bd8ea00c"><div class="ttname"><a href="group___c_o_r_e___exported___defines.html#ga0198147efa03609c64760662bd8ea00c">BCORE_FLAG_RW</a></div><div class="ttdeci">#define BCORE_FLAG_RW</div><div class="ttdef"><b>Definition:</b> <a href="b__core_8h_source.html#l00082">b_core.h:82</a></div></div>
<div class="ttc" id="group___m_o_d_b_u_s___exported___functions_html_ga75fd562c121d4610608a1ab4053408da"><div class="ttname"><a href="group___m_o_d_b_u_s___exported___functions.html#ga75fd562c121d4610608a1ab4053408da">bMB_Regist</a></div><div class="ttdeci">int bMB_Regist(uint8_t dev_no)</div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___w__t_html_ac6b64f60b8100dc86a10a524158c21ce"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html#ac6b64f60b8100dc86a10a524158c21ce">bMB_RTUS_W_t::func</a></div><div class="ttdeci">uint8_t func</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00062">b_modbus.h:62</a></div></div>
<div class="ttc" id="b__modbus_8h_html"><div class="ttname"><a href="b__modbus_8h.html">b_modbus.h</a></div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___ack__t_html"><div class="ttname"><a href="structb_m_b___r_t_u_s___ack__t.html">bMB_RTUS_Ack_t</a></div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00069">b_modbus.h:69</a></div></div>
<div class="ttc" id="group___c_o_r_e___exported___functions_html_ga078b200cdc68be6d562cc1ad323d9381"><div class="ttname"><a href="group___c_o_r_e___exported___functions.html#ga078b200cdc68be6d562cc1ad323d9381">bWrite</a></div><div class="ttdeci">int bWrite(int fd, uint8_t *pdata, uint16_t len)</div><div class="ttdef"><b>Definition:</b> <a href="b__core_8c_source.html#l00218">b_core.c:218</a></div></div>
<div class="ttc" id="group___c_o_r_e___exported___functions_html_ga249e47165f733672eae3653fcca87829"><div class="ttname"><a href="group___c_o_r_e___exported___functions.html#ga249e47165f733672eae3653fcca87829">bOpen</a></div><div class="ttdeci">int bOpen(uint8_t dev_no, uint8_t flag)</div><div class="ttdoc">Open a device. </div><div class="ttdef"><b>Definition:</b> <a href="b__core_8c_source.html#l00175">b_core.c:175</a></div></div>
<div class="ttc" id="b__config_8h_html_afc78b16ad8aebf30b9cabfc278cfb32a"><div class="ttname"><a href="b__config_8h.html#afc78b16ad8aebf30b9cabfc278cfb32a">b_log</a></div><div class="ttdeci">#define b_log(...)</div><div class="ttdef"><b>Definition:</b> <a href="b__config_8h_source.html#l00232">b_config.h:232</a></div></div>
<div class="ttc" id="structb_m_b___info__t_html"><div class="ttname"><a href="structb_m_b___info__t.html">bMB_Info_t</a></div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00081">b_modbus.h:81</a></div></div>
<div class="ttc" id="b__device_8h_html"><div class="ttname"><a href="b__device_8h.html">b_device.h</a></div></div>
<div class="ttc" id="b__core_8h_html"><div class="ttname"><a href="b__core_8h.html">b_core.h</a></div></div>
<div class="ttc" id="group___m_o_d_b_u_s___exported___functions_html_ga9e0e2e9b8286a5db0ff6ef63885b8b2e"><div class="ttname"><a href="group___m_o_d_b_u_s___exported___functions.html#ga9e0e2e9b8286a5db0ff6ef63885b8b2e">bMB_CheckRTUS_ACK</a></div><div class="ttdeci">int bMB_CheckRTUS_ACK(uint8_t *psrc, uint16_t len)</div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___w__t_html_af5105c72a61e60d3b44670de20e0c3fb"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html#af5105c72a61e60d3b44670de20e0c3fb">bMB_RTUS_W_t::addr</a></div><div class="ttdeci">uint8_t addr</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00061">b_modbus.h:61</a></div></div>
<div class="ttc" id="group___m_o_d_b_u_s___exported___functions_html_gaec54fcf815442f741b8b3f008ea67239"><div class="ttname"><a href="group___m_o_d_b_u_s___exported___functions.html#gaec54fcf815442f741b8b3f008ea67239">bMB_WriteCmd</a></div><div class="ttdeci">int bMB_WriteCmd(int no, uint8_t addr, uint8_t func, uint16_t reg, uint16_t num)</div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___ack__t_html_a5723e60ffd628510c699eddbce90be23"><div class="ttname"><a href="structb_m_b___r_t_u_s___ack__t.html#a5723e60ffd628510c699eddbce90be23">bMB_RTUS_Ack_t::len</a></div><div class="ttdeci">uint8_t len</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00073">b_modbus.h:73</a></div></div>
<div class="ttc" id="structb_m_b___r_t_u_s___w__t_html_aa60093a9a5d5d17864cfda66c47733e3"><div class="ttname"><a href="structb_m_b___r_t_u_s___w__t.html#aa60093a9a5d5d17864cfda66c47733e3">bMB_RTUS_W_t::crc</a></div><div class="ttdeci">uint16_t crc</div><div class="ttdef"><b>Definition:</b> <a href="b__modbus_8h_source.html#l00065">b_modbus.h:65</a></div></div>
<div class="ttc" id="group___c_o_r_e___exported___functions_html_ga2d5143bd4493f8069401bb433939de4f"><div class="ttname"><a href="group___c_o_r_e___exported___functions.html#ga2d5143bd4493f8069401bb433939de4f">bClose</a></div><div class="ttdeci">int bClose(int fd)</div><div class="ttdef"><b>Definition:</b> <a href="b__core_8c_source.html#l00265">b_core.c:265</a></div></div>
<div class="ttc" id="b__config_8h_html_acd9980136a3d83c88c8d99eb9e3a7f98"><div class="ttname"><a href="b__config_8h.html#acd9980136a3d83c88c8d99eb9e3a7f98">_MODBUS_I_NUMBER</a></div><div class="ttdeci">#define _MODBUS_I_NUMBER</div><div class="ttdef"><b>Definition:</b> <a href="b__config_8h_source.html#l00085">b_config.h:85</a></div></div>
</div><!-- fragment --></div><!-- contents -->
<!-- start footer part -->
<hr class="footer"/><address class="footer"><small>
Generated by &#160;<a href="http://www.doxygen.org/index.html">
<img class="footer" src="doxygen.png" alt="doxygen"/>
</a> 1.8.14
</small></address>
</body>
</html>
